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(57) Abstract: A legged mobile robot, 
particularly, a biped robot, wherein a dynamic 
model showing the relation between the motion 
of an upper body and a leg part and a floor 
reaction is provided, the parameters of gait 
patterns including the parameters determining 
the routes of the leg part are determined 
temporarily, the parameters of cyclic gait patterns 
followed by the gait patterns are estimated, the 
parameters of the gait patterns are corrected 
so that the routes of the upper body determined 
based on the dynamic model and the parameters 
of the gait patterns are converged to the routes 
of the upper body deterrnined by the parameters 
of the cyclic gait patterns, and the instantaneous 
values of the gait parameters are determined 
based on the correc te d parameters, whereby 
the gait patterns such as any step, turning angle, 
and walking frequency can be generated by 
generating freely and in real time the gait patterns 
including the floor reaction while meeting the 
requirements for dynamic equilibrium, the gait 
patterns allowing the continuous displacement 
and speed of each portion of the robot and a 
high allowance of stability can be generated 
in the boundaries between the generated gait 
patterns, and the gait patterns can be generated 
by predicting the future behavior of the robot so 
that an inconvenience such as an uncontrollable 
attitude is not produced. 
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max £ ntczitiz^-o xm2=-rz&m:mfi-^ mm o jca^ $ n N i^wgsjw 

T/At-l 

H(fCt),T)= £ • (kAt)exp(-cokAt) 

• • -ftia 

<o 

■ • '• ttl 9 
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H(t,Tyr=(AtT*exp(- 0) A.t)H(l,l)-exp{- cot)) / (l-exp(- a> At)) 
.... •••^20 

i*> ®&f ziEmitLxfrz, HCf(t>,T)*^~^<fc-rni^^ 0 * % jiiaM 

£-f v sua i o=o.i. -5)©«iiz:^zmp©^#^ i ©sots^ka 
jiztiZ'^x-eh-ox^ *e>^mmfrMZh%tm& t©^*©*#&infmK: 

IgyrrSo Elii©«:^^ZMP&JfH*. SfH lBCjarTJ;?^ »^^ZMP[ 
i]O0^^#^CZMP[i+l]-ZMP[iD/period[i] 05 >7&01&n;mii2tlZ> 
©T, ^Vt,xsu«m£5:5C 2 1 tzm-f* -5 irft£o 

• infp^HCl, period[iD#ZMP[i]+H(t, periodjlD / period|i]*(ZMP[H-l] -ZMP[i]) 

• • «&2 1 

&1>vt\ EHperiodti] Ci=0.1,... m)©#J:63g?ZMP<Df^£\ B#&I0U: 

1-1 

inf '[i]=inf[i]*exp(-cuO( X periodfkj)) 

• • • &2 2 

01 0SC^fM32:JS^ZMP»^E®cD^#^ ^-g^O^ISClS-y-ZMP 



M # x. /3 IS (^526) 
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• • • M2 8 

W*(63^(-C00At)-l) 

• • • f&2 4 

m 

W*(exp(- CO 0 At)-l)*exp(a> 0( £ perLodp])) 

i=0 

■ • • m.'2 5 
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^**KU W^&ftStiltas l 8 KHifr i#tz, SJ£3ftSi#i*s 2 

s 1 8 imt! tttmrn t * o itaiiiftu k^-cs 2 2 k^*, 
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o 

* l«H@I^^a:^2^lHl#^<D^ff^JWtt> ^Hf^^J»i:l^-(Ci-5 ( 

mm&ftmwmKzcDtifffl'^ it. .teftjeafifc 

m 1 i£HJ#^*J «k * 2 tfiliaMo Z M P tUS/ < 5 * - * & > Sfif%*«J^ft < 

tgjffi±(*ft^tfeg«KcD#xo. vote-art*** :<otxo, vo* 

©J-SKtt*. fc'«UX0t(xO, yO) tgtcttU VOiroivci* 
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f3E&ft£o CcDi&O&ftj&a-, BP-fes XO + VOAuO rgft£|iiMF<DgMjg 

01 2B©ttgifcK*'fc. ft^-CS 2 8 Kit*, ^ttDMFOtDlBmjft^ 
So 

f 1 5 0te> 01 207D- • ^ + - hbs 2 8 ©^Sg@^£©&;K38^ 
q[k]=exp(6) Ok A t)*Q[0] 

k-1 

• + exp(a> Ok A t)*(-exp(0) 0 At)-1) £ exp(- a> 0 A t)*MtotaJ/mb*2MPtotal[i]) 

i=0 ■ - 

k-1 

~exp(a>OkAt)*(-exp(<»0 At)-1) £ exp(-ia) 0 At)*mfeettoib*ZMPfeet[i]) 

i=0 

■••St26 
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->7&<fifn*rcfc*©T> ItriBo^fti^ZllPpend KJ:r>T38&*-*&ffi36ft/8 
#£#«>Sx tfcsU 9, 2 0. 2 1, 2 2, 2 3, 2 5 C^tT^rfij XA^jg 
^T^flfttfcJfcfc*, C4l*Wzmptotalfr*<, (X Y^lSW&.S©'?. Wzrapt 
ot&Ut2tkjt'<9 hJblzixZ* ) 

§6(wZMPleet[i]Ci-0.1.-,k) 2ri>S#i^ dtv& 

±m<Din< LT«J6e#lfctt^Wfeett-r«5o (XY»*5®7, Wfeet 
1*2^56^^ h;nc«:* 0 ) 

£LbJ:tK ft<Dm&,2 7&&Z 0 

<j[k]= exp(co OkAt) * qfO] + Wzmptotal + Wfeet 

• SIS: 2 8 
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* 

qDc]«Mq'M+B 

• • • &2 9 

8fc3*;2 8 fc&5*2 9 J:«K &©&SU 0£|#*o 
q|KIs=MqIP]+B 

• • • 8 0 

3^3 0£3&5$2 7«fctU &<D&5$3 
Mq[0]+B=exp(coOkAt) * q[0] + Wzmptotal + Wfeet 

* • • &3 1 

qfO]= inv(M- exp(coOkAt)I)(Wzmptotal+Wfeet-B) 

♦ • • uses 2 

*e>. eJc^-cs i o 2izm&, s*5£2 6o*ra^8^mv>r«iK±(cj:^T:^ 
s i o 6(rjt#, %immwm&ffi£&ti cod *4»0*fr*®&*»p 
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:£&ftfcZMP£3feai>T@fgZMP ti^c cn&<DW#*fM 6^{c^-r o 

ribcsw&k* umzup (zmptotai) =uumzMP+zup&iEm* t 
zMP&mMitmi 6 s^str^-r «fc a iz-&mvt-e& t> „ w**am 

o ee?ZMP^-vfcJ:^TaS^5^58tfe^Wzmptotaltt. ggfZMP 
Wznqrtotal-W2aoiptmp+a* Wtrim 

• • 8 

Wzmptmpti. 4-®2£^©<RBglZMP'<^ — VlcJ; o-C5&3rr5&j§§ 
!£&J£#*e&3a WtrimHu a = 1 fc bfc«^OZMP^JEfit:: < fcoT383rr2> 

^^Sc^-efe^o cneit m^^mm^(DmmzMP^^->{zx^ 

5$3 4£f£So 

q"= exp(<oOkAt) * qJpJ+Wzmptmp + a * Wtrim+Wfeet 

• • 4 

a= (q n -exp(o>0kAt) * q(D] - Wzmptmp - Wf eet) / Wtrim 

• • • $8 5 
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mi 2m7n- •r+-h®w.wtzm%b, ^ts3 mzm*s 4®^^ 

^Tlft^-rst^ S2 0 OKfc^T^EI^C^jgEZMP'^-^K^oT 
3&&1-£&^5fcifrjfc#Wzmptinp£-#i6 > #tt>-es 2 0 2icig^ a = i £ Ltci& 
40ZMP®Z&izJ:^xm2:?Z&n¥&m!%frmrimZjRibZo 

Wfeet£«>, K^-CS 2 0 6 KM*. *®&®<OWm&fk®& q [o] 
Ui«F£ a £*g>* 0 ftt>TS 2 0 8tzM&, IWBUfcJ:3 {Cg^ZMP^t? ^ 

fl207D-.f + -h©^{:^^ &tv?S2 0&l*„ 

SSI 8@tt^O|!!LS^-r-9-^l/-^> .7D-. ^t-ms 0 
STSiWr^irs S 3 0 0C£fr*T* BfMtKfc 
«i-eS^ZMP**a6. S 3 0 2ttg* % 4WM&><5*->*aSK, if&ftK 

^ItroBSmVttllSJ^e^ IMti:«l^iZMP (ZMPfeet ) **fij*-* 

o 

*wrS 3 0 8K3S*. ttSSB*fflWC, «fiJg^ZMP(2MPpend) £JTfflL 
, S3 1 OKit*, *«4*mv^ «A«^ZMP^&«S[«TP7k¥ttfll*J|[ 
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mi 2®:7a- . f-^-hOlttHj^M-SirN e*CV>"CS 3 2 Kit*. ^tCA 

t£fin&> fitfs 1 4 ten*), JLfao&g&no 

m&^rJi 9x&&m i o 2*ciic^&n$o 

liZMP) Vim. *<ktfB«ya*E;& (ftii:) i*> «^3>^5^t>x 
tfrfftfcjean o 4Kia£B!&ns— ^ bs^k2j#ks#i o 6k*>2I£*t, s * 

(JESP2 2R, L) tc#@33tt, B^#JE¥J*£:W>M*> 

tJH 0 21*. B«-L#fi:g£» i^^M^#^^IEB^S«tS 
£S&- *A^3$tx5t> ^n&^SSJa-T^l 2ffl©HtJj (10R(L)4 

#) ©Bus^ttit^ (fit) &m.mvTm®.3>ha-7 1 o sjcai^o mit^y 

) ^SifitltD)K 9 HOI 2f@©Hf!5<DSgffl:^ii^i!I0-r^ o 

■9-34) \z£-?x&mzti2><> tkmmmmi>tzm&*>7 ! 7'<T>xMft® : m 

SU 0 4£i£Sft5o ntfy bHZ&.bte.m&®&i%me<irrx. <9erryli 
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JHAjWfcfctt«Lfc4*||PFl 0 - 2 7 7 9 6 9 ^(ClftifflKfai&aftT^ 

©"C, ^fflJ&AjWfcfc^gUsp 1 0 - 8 6 0 8 l#C*JV>-Cfi||gt^fit^<0±iaU 
*iil2i»JSL<c*<^, glfe^oUT>t/*^Atr&j£LTffi&©:SNg.» fit®^, ^ 

* tz „ -e n <c «fc r ^ff fit^f ©»f£ t> u r ^ * ^ a k^bst? £ .5 £ -5 tc ft * © 

o 

ffi, ±m-C&M£ilZ'<£C tit. -tS5L/cHJfe©Jggg(;fev>T, ^5E^^ 
icttx.> tfH&tf^&^iM - 1 5 0 6 8#&fg-C$yg£ft.5 1 W/St^^^ttffl U 

&2 omit, z®ftw<bm2omt&ommzmzw&, ! &®ntfy »*©#&£& 
££©©#©— #1 ©£sjg©^&©$& 1 BHic««r* N sirttis^ 
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@(C*5VvcS 1 Ofr&S 2 $&-eizm"t(D*:m®<D9!m£1T'>TS 2 8 KjfM.fi 
j£«Mt (X0, V0) *<E&&-r£o -L#ffc©i£K(*. -b#tta&©ffc®fci£g 

^sf^t- « 0 ^ ®.m*ffimz-r x?imKV£&m-tz®&*Mtz t & 
# v m&iziz&wm&tbx, YXfa&st* iz&zMmmz&m-i-z&mfrib 

Y&m®4fc7viZl£Z 0 

k&v >*{zm.£L%mfevizmmn ! £ : rfr) ^m^x (xo, yo «-j:«:© 
&^t?s 406 icji^s &^uy!i^©j^ss±^emffi^g© 1 #©£# 

HtIS (HI 4@©X' " . Y' " j&^&fclTO) fr$>M.izmz9mu *o 
(Xe, Ve) t-TSo 
&l^-CS4 0 BizM^> mmotlK, (XO. VO) t (Xe, Ve) OH ( 
errx.erry ) £3tCffl**<, £«ttiaM*Cli (XO, VO) t (Xe. V 
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e) tf-SfcLT^tttftttf ft fettle pf^posi (errx.erry ) frObtt 

fcs SJ^^ffefiS;^ (X0+V0/6JO) tfiJffllR^^ (XO-VO/wO) # 
S4 l Q-e&fei*ii6t%\ts 4 1 2fcii#. (xo, vo) otti&K&m® 

®m&®m (XO+AXO, VO) , (XO, VO+AVO) £fci6. *tl*tl 

tef (Xe+AXel, Ve+AVel), (Xe + AXe2, Ve+AVe2 
Iki^S 4 1 4izm&, (Xo, vo) isZ&z&tfiE&tDmfc&mztt-fZ 

&m±#tiLmi&mtmm t L*LM&miz, ikgovuowem (xo, vo) 

S4 i o-es^^n^isowjbaLfc^is^oig-ri:*^ ftmzftztg 
itmbMisJis-zf (s 4 o 2) &mixs 4 1 Gizm&, izimE&DMfm&ft 

q CO] £0^©5S*63fcg>3 o &^-CS4 1 8{CJi^ Sf£ 1 ©H$fe<DjgJgt©f£ 

1 5@©s i o 6 tmuts;mm&ft?o 

©Sf&#K*fUr fc^Hftc+^ttragT^M-rsc: t^tt^OT, ^ 1 ©n 
JSslTI&W-*" S 5 0 O^gtS 5 0 2fcii# > £S{KZMP'<^->£* 

©ffe©4-la]#M&©#^rM-*£&ic, &$H#^£T©^iii#&£ffJi^£c: 

tlc^oT^lal^^-coi^me^ (Xe. Ve) S&ttMHI 
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tk&ftq CO] &BW<D55£Ml/>T#J&*o 
m>VS 5 0 4 Kit*. &m%&mm&6rrq*®jik<D& t m^TXit>^ S 5 

5 0 8ICii*> a*AaiU 0 1 ©^JfiO^fiRtHtKfr^ l 6 BUD KJ 

J; o Tfliierrq#/J\& < 5 Cotit A a M^tf* * J: 5 KlfcJt - > 

*H>*eS 5 1 OtCxt^ ^<7^-^iKr £03F<Z>5£#>&3fci&. S 5 1 2 Kit 

(S500) ^ttfts 5 1 Aizm^ m&mz&zntifog 
szmp^ v©<s*ig*zMP t*je-r*o 

©W'* 9 * - * CD «f O S IS Z M P '< 9 - y £ feJEIr « <}; 5 b fc 0 
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ts^xn* mn* w^Ax^-r^m^^-rtix^^ *<z>&. &*izw^ax 
m-t$miz^ cmm u ^(D^mm^mmx^Axm-tmrnizm & 

•CIS, — 

^2©^JS(DBSS^*?^TI4, a-h>jSfe (&-5Mi (X0, 

¥&m*<0'<? *-?{ZMlsX®£ft&*ff~>Xvy7<tl,X& 
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bt^$neiiZMPtt, ££Lfc^r8£III#M£©ZMP (tftBSSZMP) 
ife5£3 ft § B &Z M P ©iitttSSW^^it^ 6* ft < ftu M^^tt < * * 

aEc»»**<&/£ae>KB«zMPfiut**ft <«icr&-r«s^u 

«1*lfel»«rC§*ft tfttf"* C c b~Qh *) s — fttofcfik 

ft* *e&6 9 Mi:4;<S ^ < i£ < -5 J: «5 fcKJW *We* * 

f#*<fc <#*&!*!*<<&*#, IRttd<8£t::ttS. 
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i) &.*k®3cftmm®%bwk®&ftm\t, *®3t#mmm%, 4®&n®m 

warns <DmMo&miz&k&m&&mntf*, h<b&&s=mmmt^ *cr>&{zj&& 

tfcgt (c^fir-C § -5 J: 9 ft* ©t; &K&±mj&ift£fji c, fix 
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$ 1 cDfSJfe<DB«&*£J& 8 0>£)fccD$IIU*Jb£<Z>*II < , ^tt < t t Jift: 2 4 t 

9c9ciaimt^nmjfi. <*i»8JB»k &®&®mmt£ito S2 2) 

> ^m^©^7^-^*<E^f %*m&®'* : 7t-9mki&£®. (S2 4) 

(S2 6) 

^©^^y-^^3E-r«4-ia^^5^~^^jE#S (S3 0, S 2 0 0iN& 
S 2 0 8) . £J:tf#tf< tt>mm#EiE$n^lir^IS^©^5y-^(rS^ 
V^TWI2^[iI#S0ie|l^ffi^^'r§4-iI^^NFfil^¥K CS 2 0. S 8 0 
QfrZS 8 1 4> «-tx.5 .fcSfclfJifctfco 

©BUSS <W»'J>*) 2*«*fc«a:»»a*» h 1 <D2M§F&fiB;gfg 

zmp) toBi^^-rm^^T 5 ^ (m5®&&vmswizmi') , &K<t 
fcg* cs 2 2) Ktstx fiMamiotiut (s«£*raff£»«us) tmria^E 
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(S2 4) . &t&< t*>tirsas*irf6bs KHfcA-®&&iztfi< ®mto&<& 
n&m (S 2 e) , ^EMJBW^ofna^^^-^^ig^t, itria^jfflw^ 

#&&#361tfcJ#:5Hfe£#8! (S28, S10 0^S10 6)> HB^HMPO 

kk>tmm&&& mmmmm^y fr&±iz—%t& * ^ > i±mmto\z— 
~***eiE'r&+M&e''*5*-9m]E&& cs 3 0. S2oo^S 2 0 8) 

QMoftNHi«|«^64-nMl»lMtllltWR (S 2 0, S 8 0 o^&S 3 
*n*fti<l»J«Lfc. 

-CASTOR*. «ki>ft#W»::tt0ZMP CZMPfeet)£-f<r&Jt#© 

rae«n»iH*(^rfii-r«inKBj(iiriBM (MZMP#ffii§2 o o, s 2 0, 

fcExb) ^ffi^SHlfc^^-r^^m^S (S 2 0, S8 10)^tt< 
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. S2 0, S3 12, S8 1 4) . b t>M&&m*tlfr±#VLm& 

(S 2 0, S 3 0 0*&S 8 1 4. gtg£jftain 0 0) teffMRLfc 

o&mz&&&i'iz&M*zmmzMP&m!¥-& (hizmpshhis^ o o, s 2 

0, S 8 0 6) > 'J?ft< k*>MmWftZtltmt®ZMP bsmzup £^5. ^ 
# < £: feliriaJi^Oi&A^W^^ia^SMltig^^T 8 ^®^^® (ZMPpen 
(D^ffi-r-S^fSr^^^l/^^M^ffi^ (S 2 0, S 8 0 8),^«<t 

kfiriBjttffi * ni^m^m^^^^^mizm^xmmm^m^^j^m. 
hm**? cs 2 0, S310), 'Pk< tk>mum.misiMz.m 

2 0, S 3 1 2, S814. ±*fHttfc«82 0 2) . &&tf'pte< £fcffrfBir 

) cs 2 0, s 8 0 oa>£s 3 1 4> M^j^iBi 0 0) &m 

ntotal/mb ^I3I»€PZMPIC^2 cD#tJcmfeet/mtoal 
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U&Jl&to&m WZMP#to%2 0 0, S2 0, S 3 0 6)^ ##<fcfcfff 
&&tilZtltzM®R%bUmftR% (B&ZMP) 4>tt< it>ffli3±# 

(S 2 0, S31Q) t> ^«C< tt»l?l3»a$tl/S:M35:^-?' j e7 s ^ 

© Cfcttifce&JEfl 2 0 2, S 2 0. S 3 1 2. S314) t^SttfifcSftSifr 
iWef**, t *>g* (S 2 2) KCSl^ liieMWOlUt (B^JETO® 

SStUS) bttiBftEL1]<Dtoi!t (Bfg^R^rti^^it (gfRZMPmil) ) 

(S28, sioo^^si 06), nns4-isi^o^5^-^jrs^ 

S 4-13^^9 y-^^]E#S (S 3 0, S 2 0 0ri>£S 2 0 8) „ *jJ:Cf^tt 
«fc3e-i"«^ia^«Fil^«ft3e#« (S20, S 3 0 0j^6S3 14) m^$o 

&^"Cs BflZMP (ZMPfeet)©#mfCOV^«-l-rSc 
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J:-9T$J6&ii > #s$3 eoPfjarS^m^lfillraiiS^^ hJt/afeetzli> afeet 
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afeet=(msup* d2(xsup)/dt2+mswg * d2(xswg)/dt2)/(msiqp+mswg> 

■ • -#S 7 
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*bztzi6<D w&wm^mw®) mzMP&fb&mt, Ammmmm<om*z&& 
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